Nonlinear filtering in target tracking using cooperative 

mobile sensors 



Jiangping Hu a , Xiaoming Hu a ' 

a Optimization and Systems Theory and ACCESS Linnaeus Center, 
Royal Institute of Technology, SE-100 44 Stockholm, Sweden 



Abstract 

Collaborative signal processing and sensor deployment have been among the most important research tasks in target tracking 
using networked sensors. In this paper, the mathematical model is formulated for single target tracking using mobile nonlinear 
scalar range sensors. Then a sensor deployment strategy is proposed for the mobile sensors and a nonlinear convergent filter 
is built to estimate the trajectory of the target. 
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1 Introduction 



Sensor networks have the poten tial ability to monito r 
and instrument the real world (lArge.fe Clare! (l2000h ; 
iKumar Zhao, k Shepherdl .20021): IZhao, Shin.fc Reichl 



(|2002l ): lBrooks. Ramanathan. k Saveedl(j2003D ). Among 
many challenges of sensor networks, tracking target by 
using collaborative information processing and optimal 
networking has been an important problem in both the- 
ory and application. 

In this paper, we consider single target tracking by us- 
ing a group of mobile distributed nonlinear sensors such 
as range and direction sensors in terms of sensor deploy- 
ment. If the measurement of the target for each sensor 
is nonlinear and noisy, nonlinear filtering theory has to 
be applied to estimate the state of the target. In most 
cases, the target's dynamics is partially or even com- 
pletely unknown, which makes the modeling and esti- 
mation problem for target tracking more complicated. 
Subsequently the target's dynamics will be described 
by a linear Gaussian model and the distributed sensors' 
measurements for the target will be nonlinear and noisy. 
Our aim is to propose a convergent nonlinear filter to 
estimate the trajectory of the target based on the mea- 
surements from the scalar range sensors. Considering 
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the sensors' tracking qualities, sensor deployment has 
to be dealt with by adopting formation control tech- 
niques. This idea has also been adopted in, for example, 
iMartinez. k Bullol (|2006l ). where the authors integrated 
motion coordination strategies and extended Kalman 
filter to improv e the tracking performance of the sen- 
sor network. In ICheng. Ghosh, k Hul (|2006|) collabora- 
tive localization algorithms are proposed to reconstruct 
the position of the target in a noise-free environment. 

In many real applications, target tracking has to be 
dealt with in the presence of disturbed target dynam- 
ics and nonlinear noisy measurements. The estima- 
tion in nonlinear systems has been a n ext remely im- 
portant problem (jjulier. k Uhlmannl (|2004l ). Though 
there are now many nonlinear filtering algorithms, 
such as point-based unscented filters, density-based 
particle filters, the extended Kalman filter (EKF) has 
been a popular filter for nonlinear systems, in partic- 
ular f or target tracking problems (IMartinez. k Build 
(120061) ; ISugathadasa.Martin. k Davawansal (|2000| )). 
However, little work has been performed to ana- 
lyze the stability and convergence o f the filter, see 
lReif.Gunther.Yaz. k Unbehauenl (|2000[ ) and references 
therein. It is well known that the upper (lower) bound 
of the solution of the Riccati equation associated with 
EKF depends on the uniform controllability (uniform 
detectability) of the considered no nlinear systems (see 
iBaras.Bensoussan. k Jame"sl (|1988t ). Theorem 7). How- 
ever, with the model used in this paper, even though 
EKF has a comparative accuracy, it is difficult to show 
the convergence of EKF since the uniform complete con- 
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trollability cannot be assumed. In addition, the Riccati 
differential equations associated with the error covari- 
ance are very difficult to integrate numerically. Then 
an important problem arises: can we design a conver- 
gent nonlinear filter to track the target with unknown 
dynamics? 

The contribution of this paper is twofold: one is the 
proposal of a convergent nonlinear filter and the other 
is for appropriate deployment of the sensors. Sensor 
deployment concerns the connectivity and coverage of 
the network, which plays a k ey role in energy conserva - 
tion and monitoring q u ality (|Wang.Xing. et al.1 (|2003|) : 
iKumar. Lai, k Balogbl (|2004h ) and, at the same time, 
assures the feasibility of our proposed filter. A funda- 
mental problem, i.e., fc-coverage problem, facing sensor 
deployment for target tracking is how to deploy the 
sensors so that every point in the target region will 
be monitored by at least k sensors. For target track- 
ing with mobile sensors, since the deployment algo- 
rithm will be integrated with the estimation process, 
fc-coverage problems become more difficult to solve. In 
this paper, inspired by a virt ual vehicle approach in 
lEgerstedt.Hu.fe Stotskvi (|200lD . neighbor-based forma- 
tion control will be proposed to achieve an equilateral- 
triangle deployment and solve the 3-coverage problem 
for mobile sensors. 

The rest of the paper is organized as follows. In Sec- 
tion 2, we discuss the sensor deployment and formulate 
the mathematical model in the target tracking problem. 
In Section 3, on the basis of equilateral-triangle deploy- 
ment for mobile sensors, the design and convergence of a 
nonlinear filter will be given to track the target. In Sec- 
tion 4, the 3-coverage problem will be solved for mobile 
sensors by designing a decentralized control to achieve 
equilateral-triangle formation. 

Throughout this paper, we will use the following nota- 
tions: A is a real matrix, A T denotes its matrix trans- 
pose, tr(A) is the trace of A, \i(A) is an eigenvalue of 
A, ||A||2 is the spectral norm; for vector x, \\x\\2 is Eu- 
clidean norm and Halloo is maximum norm; < • > de- 
notes the inner product in Euclidean space; Cg> denotes 
the Kronecker product; E[-] is the expectation operator; 
col(-) denotes the concatenation; Dirac(-) is the Dirac 
delta operator. 

2 Problem formulation 

In this section, we will formulate the target tracking 
problem on sensor deployment strategy and convergent 
nonlinear filter design. 

Consider target tracking with N mobile sensors. Suppose 
that each sensor is modeled as two disks with radii r and 
r c , which indicate the sensing range and the communi- 
cation range, respectively. In order to improve the tar- 



get tracking quality, having the target sensed by at least 
k (no less than 3) sensors in a plane is critical. Mean- 
while, the sensors should be kept connected to trans- 
mit and receive data suc cessfully. It has been shown in 
IWang.Xing. et al.l (|2003f ) that if r c > 2r, fc-coverage im- 
plies connectivity of the network. For the case the target 
region is constrained in a space of dimension two, the 
problem of designing a target tracking filter will be re- 
solved in Section 3 and, the problem of how to make the 
region be 3-covered by mobile sensors in Section 4. 

Let the kinematic equation of sensor i be described by 
a nonlinear system 

*(*)=/*(*(*)>««,*(*))> « = !,••• ,N, (1) 

where Sj(£) 6 K™ is the position of sensor i and u s ^(t) is 
its input. The measurement of the target for each scalar 
sensor is nonlinear and noisy and can be expressed as 

tfc(t) - (t>Mt), Si (t)) + unit), i = 1, ■ • • ,N, (2) 

where fa £ R is continuously diffcrcntiable with respect 
to p and LUi are independent Gaussian white noises with 
covariance matrices E[uJi(ti)ujJ '(£2)] = f2jDirac(£i — £ 2 ). 
The variable p(t) (G R" 1 ) denotes the state of the tar- 
get. Whenp(£) represents the position or orientation an- 
gle of the target, the sensors will be called range sensors. 
Another kind of sensors is called velocity sensor if p con- 
tains the velocity vector of the target. 

Now suppose that the state pit) of the target evolves in 
a continuous-time linear system with partially unknown 
input: 

(pit) = Ap(t)+Bu(t), () 

where u S M™ 2 (712 < n\) is the partially unknown input, 
the initial state p(£o) is also an unknown constant vector 
and A, B are constant matrices. The unknown input is 
generated by a linear exogenous system 

fC(£) = rc(£) + F^(£), 

\u(t) = DC(t), { ) 

where £ £ R m , v € M™ 3 , T,F,D arc known matrices and 
the system disturbance v is a zero-mean Gaussian white 
noise with E[uit)u T is)] = *Dirac(£ - s). 

Then the target's dynamics (3) and the kinematics (1) 
and the measurements (2) of N sensors compose an ex- 
tended system 

s = fis,u s ), (6) 
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y = <t>{Pi s) + a, (7) 

where y = col(yi,--- ,J/jv),s = col{s\,--- ,sn),u s = 
col(u s> i,--- ,u StN ), f = co/(/i,-- - ,ftf),cj = col(wi, 
• ■ ■ , un) and 



Remark 1 Here we cannot assume that system (A, B) 
is (uniformly) controllable. Thus, the boundedness of the 
solution of the Riccati equation associated with EKF cor- 
responding to system (5), (7) can not be guaranteed. 

Let C(p, s\ be the Jacobian matrix of <f>(p,s) with respect 
to p and C = [C(p, s), Ojvxm]- If there is no confusion, 
C(p,s) will be abbreviated as C in the sequel. When 
the observability of time- varying system with C or C is 
mentioned, p and s are regarded as constants. In order to 
investigate the observability of system (^4, C) , we make 
an assumption as follows: 

Assumption 2 The pairs (A, C) and (T, D) are observ- 
able and no eigenvalue of T is a transmission zero of 
system {A, B, C). 

The following result can be checked by Hautus test and 
the proof is om itted here (the detail can be found in 
iHu.fc Hul (12001 ). 

Lemma 3 Under Assumption 2, the matrix pair [A, Cj 
is observable. 



Remark 4 For system (A,B,C) in this paper, we will 
show in Section 3 that, in fact, {A, C) will be also uni- 
formly detectable by finding a gain matrix H(p, s) such 
that A + HC will have negative real-part eigenvalues for 
arbitrary time-varying variables p and s. 

In terms of Lemma 3, a nonlinear observer-based filter 
can be proposed for systems (5) and (7): 




H P {y ~ s)), 
cj){p, s)). 



(8) 



In this paper, we limit ourselves to nonlinear observers 
that satisfy the following constraints: 1) H p ,Hq are 
gain matrices to be designed such that H p C{p,s) and 
H^C(p,s) are constant matrices; 2) the observer is an 
asymptotic observer for the given system in the absence 
of system disturbance v and measurement noise u. The 
motivation for the second constraint is that the observer 
should be an possible asymptotic observer even when 
some, or all, components of the system state or the 
measurements are noise free. 



The nonlinear function <f>(p, s) can be expanded up to 
first order via 

cj)(p, s) = <f>(p, s) + C( P , s)(p -p) + A(p,p, s), (9) 

where A(p,p, s) is the remaining nonlinear term. The 
estimation errors are defined by e p = p — p, e^ = £ — £. 
Then we can have the nonlinear error dynamics 



e p = (A - H p C(p, s))e p + BDe^ - H p A(p,p, s) - H p lo, 
e c = Te c - H c C(p, s)e p - H c A(p,p, s) - H q lo + Fv. 

(10) 



To examine the error dynamics (10), consider a general 
Ito stochastic differential equation 

de(t) = g(e(t))dt + b{t)dQ{t), (11) 

where Q(t) is a standard Brown motion. 

Then a different ial genera t or ass ociated with e(t) is de- 
fined as follows ijZakai M.I (|1967ft ): 

A") = ^9{e{t)) + ±tr(b(t)b T (t)Kc SS (-)) (12) 

where Hess(-) denotes the Hessian matrix. 

Now a key lemma to show the stochastic boundedness or 
stabili t y is given as follo ws (lReif.Gunther.Yaz. fc Unbehauenl 
(|2000D : IZakai"Ml (119671) 1: 

Lemma 5 If there is a stochastic process V(e(t)) and 
positive numbers Ai, A2, A3, e such that 



Ai||e(t)|| 2 <neW)<A 2 ||e(^ 



(13) 



and 

CV(e(t))<-\ 3 V(e(t))+e (14) 
are fulfilled, then the stochastic process e(t) is exponen- 
tially bounded in mean square, i.e. 



S[|| e (t)l| 2 ]<^||e(0)||e-^ + 



Ai 



A1A3 



(15) 



for every t > 0. 



In the subsequent sections, we will firstly give a con- 
struction of nonlinear filter (8) and analyze its stability. 
Secondly we will discuss a deployment for mobile sen- 
sors in order to ensure the existence of nonlinear filter 
(8) and improve the tracking quality as well. 

3 Filter design and analysis 

In this section, a nonlinear filter will be built to track the 
target by using mobile range sensors. Then the stochastic 
stability of the filter will be analyzed. 
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3. 1 Target tracking filter design 

Suppose that the target dynamics (3) is expressed as 
follows: 

' X = V, 



v = u, 



(16) 



where x, v, u G R" denote the position, velocity and ac- 
celeration of the target, p = col(x, v), 



oo V /„ 



Additionally, the acceleration u is given by the exoge- 
nous system (4). 

In the rest of the paper, we will consider only scalar range 
sensors whose measurements of target are given by 

yt(t) =<j>i(x(t),s i (t))+oj i {t) eR, i = !,••• ,N (17) 



or, 



V = <t>{x, s) + u € 



niV 



(18) 



To reconstruct the state of the target, an assumption on 
the rank of Jacobian matrix C(x, s) is made: 

Assumption 6 For continuous differentiable function 
4>(x, s), there exists a number N such that the Jacobian 
matrix C (x , s) = ^ (x,s) is column full rank. 

The assumption suggests that when enough number of 
sensors arc placed in a finite dimensional state space, we 
can always find that the gradients ^g^'^ are linearly 
independent and then the reconstruction of the states 
of the target will be possible. As N turns larger, the as- 
sumption on Jacobian rank becomes satisfied more eas- 
ily. For example, if we take the measurement function as 

4>{x,s) = col(\\x - si||, • • • , ||x- s N \\). (19) 

It follows that the Jacobian matrix is 



col( 



\\x- Sl \ 



{x - Sn) 1 
IIx-sjvII 



)■ 



When three or more sensors are placed in the plane, 
it is easy to find non-collinear positions relative to the 
target for the sensors. This is just the reason why we 
should consider the 3-coveragc problem in mobile sensor 
network in next section. 

In what follows, for the sake of constructing a filter for 
the extended system (16), (4) and (18), we investigate 
the structure of system (4). From Assumption 2, (r, D) 



is observable, then there exists a matrix G € M" iXTl such 
that r — GD is a Hurwitz matrix. Then, for an arbitrary 
positive definite matrix £ IR mxm , there is a symmet- 
ric positive definite matrix £ I mxm such that 

P c (r-GD) + (T-GD) T P C = -Q c . (20) 



The following assumption is given to guarantee the con- 
vergence of the proposed nonlinear filter (8) associated 
with the extended system (16), (4) and (18). 

Assumption 7 For gain matrix G in equation (20), we 
have the following two relations: 

(1) P C (T - GD)G + wD T P 1 = 0, 

(2) P\{DG - + (DG - ±I n ) T Pi = -Qx, 

where w > 1 and Q\,P\ are n-dimensional symmetric 
positive definite matrices. 

Now a nonlinear filter is proposed as follows: 



A BD\ p^ 

,o r J [o 



+ H{x,s){y-4>{x,s)) (21) 



where p = (x T ,v T ) T , and the gain matrix H(x,s) 
MJ7 1 C T (x,s), 



M 



( (a- l)I n ^ I P 1 ^G T D T P 1 \ 
\G(%I n - ^ 1 P^G T D T P 1 ) - P^D^PJ 



d T (j) d(j) sr^dfa d T (j) l A 



a >- 



dx 



w — 1 

With Assumption 6, the inverse of J± is well defined. 
3.2 Stability analysis 

Now we turn to the stability analysis of filter (21). 

Define e p = p — p, e^ = £ — (, then the nonlinear error 
dynamics (10) can be rewritten in a compact form: 

e = Ae- H(x, s)A(x, x, s) + Bv- Hu>, (22) 

where 



i = A- H(x,s)C(x,s),B 



02n x m 

, F . 
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and A(x,x,s) satisfies 

i(x, s) + C{x, s){x — x) + A(x, x, s). 



(X, S) 



Assumption 8 There are positive numbers S, x such 
that the remaining term A(x, x, s) is bounded by 



\A(x,x,s)\\< X \\x-x\\' 



(23) 



for \\x — x\\ < 5. 



Assumption 9 There is a positive number 7 such that 
the smallest eigenvalue of matrix J± is satisfied for all 
t > 0: 

A mi „(J £ ) > 7. (24) 

Remark 10 If we can resolve the 3-coverage problem in 
the mobile sensor network, this assumption will be ful- 
filled since J± is bounded positive definite when N sen- 
sors are deployed in the interested area (compact subset 
of Euclidean space) with equilateral-triangle formation, 
which will be considered in Section 4. 

Definition 11 In equation (22), if there exist positive 
numbers a\, ci2, 03 such that 



£[||e(t)|| 2 ]< ai ||e(0)||e- 



a 3 



(25) 



holds for every t > 0, we say that the nonlinear filter (21) 
can track the target. 

Now a main result will be presented as follows: 

Theorem 12 Consider a target with disturbed dynam- 
ics (16), (4) and N mobile sensors with nonlinear mea- 
surements (18). Under Assumptions 2, 7, 8 and 9, the 
filter defined by (21) can track the target. 

Proof: Firstly, for system (22), we will show that (A, C) 
with given gain matrix H {x, s) will be stabilizable under 
Assumption 2. A variable transform is defined as follows: 



Te, 



(26) 



where 



f In \ 



T 



In 

\ -G I m j 
Then the error dynamics (22) is transformed to 

g = Ae-THA(x,x,s)+TBv -THw, (27) 

where A = TAT- 1 . 



Define Vie) = e T Pe, where P is a symmetric matrix 
such that 



P 



( P l -Pr > 

-Pi voP x 
V pj 



[w > 1), 



(28) 



and Pi, P^ and zu satisfy Assumption 7. It is easy to see 
that P is positive definite by Schur Complement For- 
mula. Obviously, V(e) is bounded by 



A min (P)e T e < V{e) < A max (P)g T e 



(29) 



where A m i n (P) and A max (P) are the smallest and largest 
eigenvalue of P, respectively. 

For the given stochastic process V(e), the differential 
generator is given by 



CV(e) =e J (PA + A 1 P)e - 2c 1 PTHA(x, x, s) 
+ tr(PTBB T T T ) + tr{PTHH T T T ). 



(30) 



Under Assumption 7, it is not difficult to obtain that 



A 



( ^~iPi 1 G T D T Pi -(a- l)I n /„ \ 

^ t P- 1 G t D t Pi %I n DG D 



\ 



P^D T Pi 



(T - GD)G T-GD ) 



thus wc have 



Q =: -(PA+A T P) = Diag{2(a l)P u wQi,Q c }, 

w 

which is a positive definite matrix due to Assumption 
7 and a > -^r. Thus, the matrices A and A will be 

•uj— 1 

Hurwitz stable. 

Let A m i n (Q) be the smallest eigenvalue of Q. By As- 
sumptions 8,9, then the generator is 

CV(e) < - (A mi „(Q) - 2 x A max (P)||T|| 2 ||P|| 2 p||)g T g 
+ X m3X (P)\\T\\ 2 2 (tr(FF T ) + tr(HH T )). 



Since \\H\\l < tr{HH T ) < \\ M \\ 2 2 tr( Jr 1 ) < n 1 ^-, we 
have 



l A /^||M|j 2 ||T|| 2 ||g||)g T g 



X max (P)\\T\\ 2 2 (tr(FF 



■-JIM). 
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Defining 

S = min(||T|| 2 <5, 



(Q) 

XK^{P)M\T\\ 2 \\M\\ 2 



e = \ max{P )\\T\\t(tr(FF T )+n l ^M) 
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and using (29) one obtains CV(e) < —r]V(e) + e with 

^ — 2A max (P) 



A m in(Q) £ or <- ^ According to Lemma 5, 



E[\\m\\ 2 } < Y^P(0)||e-"* 



Amin(-P)?7 



> (32) 



by Definition 11 and the transformation (26), the con- 
clusion follows. 




Fig. 1. Notations of angles and distances 
Then we can rewrite the unicycle model (33) as 

d% = —v a ,i cos^,; - u s ,i_i cos(7r - Oi - Pi), 



= Wi - Wi_i, 



shift 



Vs '\ 1 sin(7r - Oi - Pi). 



(34) 



4 Motion coordination of sensors 

In this section, we discuss conditions for deploying the 
mobile sensors that guarantee Assumption 6 and As- 
sumption 9, which play an essential role in the proposed 
filter design. We will design neighbor-based control so 
the mobile sensors move in equilateral-triangle forma- 
tions. 

Suppose that the interconnection topology of the sensor 
network is a tree. For range sensors, the tree intercon- 
nection topology means that sensor i can measure the 
position (i.e. distance and bearing angle with respect to 
sensor i) of sensor i — 1 for i = 1, • • • , TV. Additionally, 
suppose that all sensor can get the states of the esti- 
mated target, which can be regarded as a virtual sensor 
labeled 0. 

A unicycle model is used to describe the kinematics of 
sensor i for i = 1, • ■ ■ , TV, i.e. 



v s ,i cos tp l 
v s .i sin ipi. 

Wj, 



(33) 



where Si = {x Si i, y s ,i) T G is the position, u S) j is the 
translational velocity, ipi is the orientation angle and w, 
is the angular velocity. Here, the control to be designed 
is u, i and w,-. 



Let di denote the actual distance between sensor i 
and i — 1 (while do,» > is the corresponding de- 
sired distance), let Pi be the actual bearing angle from 
the orientation of sensor i to edge Siti-i and /3o,i 
the corresponding desired bearing angle (see Fig. 1). 
Here, /?, and /3o,i are constrained in the radian interval 
[-7r,-7r/2)U(-7rA 7r /2)U( 7r A 7r ]- Note that the de- 
sired formation is defined by di = c?o,i and Pi = /?o,i for 
i = 1, • • • , TV. Finally, define 9i = tpi — Pi-i. 



Inspired by the path-fo l lowin g control presented in 
lEgerstedt.Hu.fc Stotskvl (|200lD . a virtual sensor ap- 
proach will be used. A reference point (x® t , y® s ) is 
chosen on Sj 's axis of orientation at a distance do,i with 
bearing angle Po,i- Then we have 



x° si = x Sji + d ,i cos(<^ + p ,i), 
y s ,i + d ,ism(tpi + /3 ,i). 



(35) 



Derivation of equation (35) in combination with unicycle 
model (33) gives the following relationship: 





cos(yi+ffo,i) sin(yi+ffo,i) 

COS /3o,i COS /3o,i 

sin <pi cos <pi 

do,iCOS/3o,i do,iCOS/3o, 



On the one hand, the initial values of /3o,» can be taken 
in Po,i G [-7r,-7r/2) \J(~tt/2,tt/2)\J(w/2,tt} in order 
to achieve equilateral-triangle formation with tree inter- 
connection topology. However, once the target changes 
its orientation very fast, it is both necessary and efficient 
to decrease response formation time for target tracking 
in practice. Hence, we need to regulate the desired bear- 
ing angles timely. 

An appropriate choice for the dynamics of the desired 
bearing angle /3o,j is given by: 



if r°K~Y° a '' I < x. 
x o+yq. ~ 



Po,i = 



1+t 2 



if 



■'• I '.'/II -111 )■'•() 

«2 



x o+Vo 

jt-[7 otherwise, 



(37) 



for some threshold x > and < g < 1 . 



6 



On the other hand, if x° s i and if). i are chosen as 



-kt{ys.t - +y s ,i-i, 



(38) 



for positive number fcj, the virtual sensor of sensor i 
will be driven to sensor i — 1. Note that when i = 1, 
{x s ,i-i,y s .i-i) T = (x ,yo) T will be the position of vir- 
tual sensor 0. 

However, for range sensor i (> 2), it is difficult to obtain 
the information of the velocity of its neighbor, i. e. sensor 
i — 1, so we need an assumption on the velocities of all 
mobile sensors: 

Assumption 13 For both sensor i (1 < i < N) and the 

target, the velocities are bounded, i.e., yjx 2 ~~+ y 2 \ < k s , 
and \/xq + y 2 < k v , for some positive k s and k v . 

If the estimation error of the target's velocity is small 
enough, from Assumption 13, the virtual sensor i (1 < 
i < N) will still approach to sensor i — 1 when the gains ki 
are taken large enough and so we can ignore the velocity 
of sensor i — 1 in equation (38): 



-h(y° a ,i - y s ,»-i). 



(39) 



From the fact 



x° s j - x s ,t-i = d a j cos(/3 ,i + Vi) - di cos(/3j + ipt), 
- y s ,i~\ = d Q j sin(/3 ,j + tfi) - di sin(ft + <fi), 

and combining equations (37) and (39), the formation 
control (36) for sensor i is given by 



■(diCOs(/3i - A),i) - d .i), 



C0S t (*» 

% — — (diSin/3,: - d ,i sin/3 ,0 - 0o,i- 

d ,i cos/3 , 4 



Then the result about the equilateral-triangle sensor de- 
ployment can be stated as follows: 

Proposition 14 Under assumption that the velocity of 
sensor i — 1 is zero, for sensor i with the modified uni- 
cycle model (34) with control (40) and any initial values 
ft(0),A),i(0) (G [-7r,-7r/2)UHr/2,7r/2) U(7r/2,7r]), 
for all positive constants e\, ti, there exist positive num- 
bers ki, g and Tq such that for every t > Tq 

\d% - di,o\ < ei, \Pi - /?i,o| < £2- 



Proof: Consider system (39). Let e l x = x^^ — Xs^-i, e l y 
y° a - Vs,i-i, then we have 



e x kiC x x s i—i, 
e'y = -kie l y - y s ,i-i. 

Under Assumption 13 we have from (41) that 

|e*(i)| < e- M | e ;(0)| + max(k v ,k s )/k l 



(41) 



(42) 



|e;(i)| < e- fc '*|e;(0)| + max{k v ,k s )/ki. 
The conclusions follow since 

di,0 ~ yj 'e x (t) 2 + e y {t) 2 < d t < d ifi + ^ e x {t) 2 + e y (t) 
and 

dosing +A,o) - e l y (t) 



tan(0j + Pi) 



e? cos((/> 8 +A,o) ~ 4(*) 



Remark 15 When the sensors achieve the desired for- 
mation, Assumptions 6 and 9 will be guaranteed. 

5 Conclusion 

In this paper, we designed a nonlinear observer-based fil- 
ter to track a single second order linear Gaussian target 
by using measurements from N scalar range sensors and 
analyzed the the stability of the proposed filter in the 
sense of mean square. In order to ensure the feasibility 
of the tracking filter, an equilateral-triangle sensor de- 
ployment was proposed for the convergence of the filter 
by neighbor-based formation control. A very challeng- 
ing topic for future research is the tracking of multiple 
targets using mobile sensors. With issues such as data 
association to overcome, it is far from trivial to extend 
the results for a single target to such cases. 
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